A REFERENCE SIGNAL GENERATOR FOR AN INTEGRATED SENSING SYSTEM 



Cross-Ref erence To Related Applications 
[001] The present invention is related to provisional 
application Serial No. 60/450,065 (Attorney Docket 202-0758) 
entitled, "A REFERENCE SIGNAL GENERATOR. USED IN THE INTEGRATED 
SENSING SYSTEM FOR AN AUTOMOTIVE VEHICLE," filed on February 
26, 2 003 and incorporated by reference herein. 

Technical Field 

[002] The present invention relates generally to a vehicle 
sensing system and, more specifically, to a reference signal 
generator for an integrated sensing system. 

Background 

[001] Various automotive vehicles have recently begun 
including vehicle control systems. Such vehicle control 
systems incite yaw stability control systems, roll stability 
control systems, integrated vehicle dynamic control systems, 
etc. The ongoing goal of vehicle controls is to achieve a 
coordinated system level vehicle performances for ride, 
handling, safety and fuel economy. 

[002] With current advances in mechatronics , vehicle controls 
have increased opportunities for achieving performances, which 
were previously reserved for spacecraft and aircraft. For 
example, gyro sensors, previously only used in aircraft, have 
now been incorporated in various vehicle controls, and the 
anti-lock brake systems invented for airplanes are now 
standard automotive control systems. Current sensor 

technology generates ever increasing opportunities for vehicle 
control . 



[003] A typical vehicle control system utilizes 3 -dimensional 
vehicle motions. For example, during yaw stability and roll 
stability controls, the control task involves three- 
dimensional motions along the vehicle roll, pitch, and yaw 
directions and along the vehicle longitudinal, lateral and 
vertical directions. 

[004] The coupling between different motion directions should 
not be neglected in most maneuvers involving vehicle roll over 
or vehicle yaw. For example, excessive steering of a vehicle 
will lead to excessive yaw and lateral motion, which may cause 
large rolling motion towards the outside of a turn. If the 
driver brakes the vehicle during the excessive steering, the 
vehicle will also experience roll and pitch motions in 
conjunction with lateral and longitudinal accelerations. 
Therefore, a successful vehicle dynamics control should 
involve an accurate determination of the vehicle roll, pitch 
and yaw attitude signals (side slip angle signal J3 ) . 

[005] Currently, inertial measurement units (IMUs) and various 
other sensors used in aerospace vehicle controls have been 
incorporated in automotive vehicles for inertial control . 
IMUs have been used in inertial navigation systems (INS) for 
aircrafts and satellites for decades. Typically, an INS 
system determines the attitude signal of a flight vehicle 
through IMU sensor signals. 

[006] An IMU sensor set includes three gyros and three linear 
accelerometers . An INS contains an IMU and a processor unit 
to compute the navigation solutions necessary for navigation, 
attitude signal reference and various other data communication 
sources . 

[007] Although INS systems are sufficient to generate a 
navigation solution, over time the computation as a function 
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of IMU sensor signals drifts, and the errors associated with 
the computation increases. Sometimes these errors increase 
such that a navigation solution is unattainable within the 
INS. To mitigate this problem and to compute a correct 
navigation solution over the entire flight, external 
navigation sources are used to continually correct the 
attitude signal computations as a function of IMU sensor 
signals. One of the more reliable of external sources is a 
GPS system with one or multiple GPS receivers. Such a system 
has been used to determine a rough attitude and velocity 
signal reference of a vehicle in flight. 

[008] Current automotive vehicle systems experience a similar 
signal drift problem in vehicle attitude and velocity signal 
determination. Although the drift is not as severe as in 
aerospace vehicles, it generates errors within the vehicle 
control system such that the vehicle control system engages 
improper actions. 

[009] It would therefore be desirable to determine reference 
signals, which function in place of GPS reference attitude and 
velocity signals used for correcting attitude signal 
computation in INS systems. In other words, it would be 
desirable to obtain reference attitude and velocity signals as 
functions of sensor signals but without using extra external 
sources like GPS. 

Summary of the Invention 

[0010] In one aspect of the invention, . a vehicle control: 
system includes a sensor cluster within a housing generating a 
plurality of signals including a roll rate signal, a pitch 
rate signal, a yaw rate signal, a longitudinal acceleration 
signal, . a lateral acceleration signal, and a vertical 
acceleration signal. . Ah integrated controller includes a 
reference signal generator, the reference signal generator 
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generating a reference lateral velocity signal as a function 
of a kinematics road constraint condition, a dynamic road 
constraint condition, and singularity removal logic. A 
dynamic system controller receives the reference lateral 
velocity signal and generates a dynamic control signal in 
response thereto. A vehicle safety system controller receives 
the dynamic control signal and further generates a vehicle 
safety device activation signal in response thereto. 

[0011] In a further aspect of the invention, a method for 
controlling a safety device for a vehicle includes generating 
a reference lateral velocity signal as a function of a 
kinematics road constraint condition, a dynamic road 
constraint condition, and singularity removal logic- 
eliminating a singular point in a computation of the reference 
lateral velocity signal ; generating a lateral velocity signal, 
a roll attitude signal, a pitch attitude signal, and a side 
slip angle signal as a function of a reference computational 
method including the kinematics road constraint; generating a 
lateral velocity signal and a reference side slip angle signal 
from the dynamic road constraint condition as functions of the 
kinematics road constraint; generating a dynamic control 
signal in response to the vehicle reference velocity signal 
(e.g. reference lateral velocity signal) ; and receiving the 
dynamic control signal and further generating a vehicle safety 
device activation signal in response thereto. 

[0012] Thus, the present system may be incorporated in such 
systems as a rollover stability control system (RSC) , a yaw 
stability control system, an ABS/TCS control system and a 
power-train control system for fuel economy purpose. 

[0013] One advantage of the invention is that the sensor 
cluster in tandem with the integrated controller generates 
accurate vehicle attitude signal and velocity signals. More 



specific example is the vehicle longitudinal velocity. During 
braking or throttle conditions, the wheel speed signal alone 
would not be able to generate accurate vehicle reference speed 
(longitudinal velocity), which is used in wheel . slip control 
for achieving RSC/TCS/ABS functions. When the wheels of one 
side of the vehicle are up in the air . (due to large . roll 
trending of the vehicle) , those wheel speed information are no 
longer the valid indications of the vehicle speed. In off-road 
driving, more than one wheels could behave independently of 
the vehicle speed. 

[0014] Another advantage is the substantially improved 
accuracy of current vehicle dynamics and predicted vehicle 
dynamics as used in but not limited to rollover stability 
control systems, yaw stability control systems, ABS/TCS 
control systems, power-train control systems. 

[0015] Still a further advantage is the ability to identify 
the vehicle parameter changes. For example, the loading or 
mass variation of the vehicle could be identified so that 
appropriate level of control actions could be adjusted in 
proportional to the vehicle loadings. 

[0016] Another advantage is the ability to detect the sensor 
misalignment errors and sensor plausibility check. The sensor 
misalignment errors have two portions (i) the sensor mounting 
errors; (ii) the uneven loading conditions generating 
misalignment between the loading vehicle and the unloading 
vehicle. Such : an identification of the sensor misalignment 
errors could substantially improve the accuracy of the 
predicted vehicle operation states. 

[0017] Another advantage is the ability to monitor and detect 
the potential abnormal states of the vehicle including, but 
not limited to, tire under-inf lation, tire imbalance, and 
suspension wear, tire wear and tire misalignment. 
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[0018] Other objects and features of the present invention 
will become apparent when viewed in light of the detailed 
description of the preferred embodiment and when taken in 
conjunction with the attached drawings and appended claims.. 

Brief Description Of The Drawings 

[0019] Figure. 1 is a diagrammatic view of a vehicle in 
accordance with one embodiment of the present invention. 

[0020] Figure 2 is a diagrammatic view of a vehicle system in 
accordance with Figure 1 . 

[0021] Figure 3 is a diagrammatic view of a vehicle system in 
accordance with another embodiment of the present invention. 

[0022] Figure 4. is a logic flow diagram of a method for 
controlling a vehicle dynamic system in accordance with 
another embodiment of the present invention. 

Description Of The Preferred Embodiment 

[0023] In the following figures the same reference numerals, 
will be used to identify the same components. The present 
invention is preferably used in conjunction with vehicle 
control systems, which include, but are not limited to a yaw 
stability control system, a roll stability control system, an 
integrated vehicle dynamics control system, or a total vehicle 
control system for achieving fuel economy and safety and other 
vehicle level performances. 

[0024] The integrated system controller or integrated sensing 
system controller (ISS) in the present invention estimates and 
predicts the vehicle operation states including vehicle global 
and relative attitude signals ,. vehicle directional velocities, 
forces and torques applied to a vehicle, etc.; generates a 
sensor plausibility check; monitors the abnormal conditions of 



6 



the moving vehicle; and corrects the sensor mounting errors of 
the sensors . The information generated from the integrated 
system controller is used to initiate control commands for 
various control systems including, but not limited to: power-, 
train controls, brake controls, steering. controls, 
transmission controls, suspension controls, etc. Additional 
controls include warnings to drivers of possible abnormal 
conditions such as: tire under inflation . and unbalanced tires, 
on-line conditioning, and calibration of the errors in sensors 
due to mounting errors. 

[0025] Referring to Figures 1, 2, and 3 a vehicle control 
system 10 for an automotive vehicle 14 having a controller 
(here embodied as the integrated system controller 12), having 
a reference signal generator 15 (RSG) (reference signal 
generator) , is illustrated. The system 10 also includes a 
sensor cluster 16 or inertial measurement unit (IMU) sensor 
cluster within a housing 17, wheel speed sensors 24, steering 
angle sensors 26, suspension height sensors 30, local actuator 
sensors 32 used by the subsystem controls, a dynamic system 
controller 33, a braking controller 34 and various alternate 
vehicle actuators 36, all of which will be discussed in detail 
later. 

[0026] The system components are connected in the following 
possible arrangement: the integrated system controller 12 is 
electrically coupled to the sensor cluster 16 and various 
other .vehicle sensors 24, 26, 30, 32. Signals from the 
integrated system controller 12 are received in a dynamic 
system controller 33, including the yaw stability controller 
40, the roll stability controller 42, the antilock braking 
system (ABS) controller 44, and the traction control system 
(TCS) controller 46. Signals from the dynamic system 

controller 33 are received in a braking controller 34 or 
vehicle safety system controller. Braking controller signals 
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are received in vehicle and vehicle actuators 36, such as 
brake calipers and braking devices. 

[0027] The integrated controller 12 includes sensing 
algorithms including but not limited to reference attitude 
signal and reference directional velocity determinations, 
global /relative attitude signal determination, directional 
velocity determination, sensor plausibility check, sensor 
signal conditioning, sensor error compensation, road profile, 
surface condition determination, vehicle parameter 
determination and abnormal state monitoring. 

[0028] The integrated controller 12 includes various control 
units controlling the aforementioned sensing algorithms. 
These units may include: the reference signal generator 15 
(RSG) (reference signal generator) , which includes an attitude 
signal reference computation and a velocity reference 
computation, a road profile unit 72 (road profile 
determination unit (RPD) ) , an attitude signal unit or relative 
attitude signal determination unit 74 (RAD), a global attitude 
signal unit 76 (global attitude signal determination unit. 
(GAD) and a directional unit 78 (directional velocity 
determination unit (DVD)), a sensor plausibility unit 80 
(sensor plausibility check unit (SPC) ) , an abnormal state unit 
82 (abnormal state monitoring unit (ASM) ) , a sensor signal 
compensating unit 84 (SSC) , an estimation unit 86 (force and 
torque estimation unit (FATE)), a car body to fixed reference 
frame unit 88 (body to reference unit (B2R) ) , a normal load 
unit 90 (normal loading determination unit (NLD) ) , and a 
vehicle parameter unit 92 (vehicle parameter determination 
unit (VPD) ) . Signals generated from any one of the 

aforementioned units are referred to prediction of vehicle 
operation states signals. 
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[0029] The integrated controller 12 receives a roll rate 
signal, a pitch rate signal, a yaw rate signal, a longitudinal 
acceleration signal, a lateral acceleration signal, and a 
vertical acceleration signal from the sensor cluster 16 and: 
other signals from other vehicle sensors, and . generates a 
vehicle reference velocity signal (e.g. a reference lateral 
velocity signal) and various other control signals in response 
thereto, such as an estimate of vehicle operation states 
signal and a prediction of vehicle operation states signal. 

[0030] The system 10. includes the sensor cluster 16., wheel 
speed sensors 24, steering angle sensors 26, suspension height 
sensors .30, and local sensors 3 2 used by the subsystem 
controls. Such sensor sets cover almost all existing vehicle 
control functions. As an illustrative example, the yaw 
stability control 40 uses only a portion of the sensors from 
the system sensor set, such as those generating 4-wheel drive 
reference signals from the reference signal generator 15 and 
side slip angle signal computations from the directional unit 
78. 

[0031] The sensor cluster 16, within the housing .17, includes 
a- roll rate sensor 46 generating a roll rate signal, a pitch 
rate sensor 48, generating a pitch rate signal, a yaw rate 
sensor 50 generating a yaw rate signal, a longitudinal 
acceleration sensor 52 generating a longitudinal acceleration 
signal, a lateral acceleration sensor. 54 generating a lateral 
acceleration signal, and a vertical acceleration sensor 56 
generating a vertical acceleration signal. 

[0032] The sensor cluster 16 is mounted on the center of 
gravity of the vehicle 14 (or mounted on any location of the 
vehicle 14 that can be transformed into the center of gravity 
of the vehicle 14), the wheel speed sensors . 24 are mounted at 
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each corner of the vehicle 14, and the rest of the sensors are 
mounted oh their respective locations in the vehicle 14. 

[0033] As was previously mentioned, the sensor cluster 16 
includes three gyros 46, 48, 50 and three ' linear 
accelerometers 52, 54, 56. The three gyros 46, 48, 50 and 
three linear accelerometers 52, 54, 56 in the sensor cluster 
16 are calibrated and mounted along the vehicle body-fixed 
directions, x , y and z. 

[0034] As those skilled in the art will recognize, the frame 
f rom x, y and z is referred to as a body frame, whose origin 
is located at the center of gravity of the car body, with the 
x pointing forward, y pointing off the driving side (to the 
left), and the z pointing upward. The angular rate outputs of 
the sensor cluster measure the car body angular rates along 
the body- fixed axes and are denoted about their respective 
axes as Q) x for the roll rate, a) y for the pitch rate and 0) z for 

the yaw rate. The acceleration outputs from the sensor 
cluster 16 are measures of the car body directional 
accelerations along the body-fixed axes and are denoted about 

their respective axes as a r for longitudinal acceleration, a v 

■ ■ * 

for lateral acceleration and a z for vertical acceleration. 

[0035] The wheel speed sensors 24 are mounted at wheel 
locations and are denoted as w lf ;w rf9 w /r , w rr for left-front 58 , 

right-front 60, left-rear 62 and right-rear wheels 64 
respectively. 

[0036] The. roll, pitch and yaw attitude signal angles of a 
vehicle 14 are related to the roll angular rate, pitch angular 
rate and yaw angular rate sensor signals through coupled 
interactions, rather than simple integrations and 
differentiations. Simple integrations work when^ the different 
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motions of the vehicle 14 are decoupled. In general, 

complicated relationships . exist among the vehicle attitude 
signals and the angular rates. If the vehicle roll, pitch and 
yaw attitude signal angles are respectively denoted as 0 r9 0 v ■ 

and 0 Z , then this complicated relationship can be expressed in 
the. following functional relationship due to the Euler 
transformation. 

0 X = co x +[oo y sin(0 x ) + O) z3 cos(0J]tan(0 v ) 
0 y =C0 y cos(0 x )-a) z $m(0 x ) (1) 
0 z =[co y sm(0 x ) + <D z cos(0 x )]sec(0 y ) 

[0037] The relationship depicted in the above equation reveals 
complicated nonlinear functions. The above ecjuation indicates 
a simple integration of the roll rate, i.e., 

0 

will fail to provide an accurate estimation of the vehicle 
roll attitude signal used in vehicle dynamics control (for 
example in roll stability control). The above simple 

integration only provides accurate information about the roll 
attitude signal angle when (a) both the pitch and yaw rate of 
the vehicle are negligible, which means the vehicle is 
dominated by roll motion; (b) the roll attitude signal angle 
and yaw rate are negligible, the pitch attitude signal is 
limited; and, (c) the pitch attitude signal angle is 
negligible with non-extreme pitch and yaw rates. All those 
three driving conditions are not generally true when the 
vehicle is in an excessive maneuver, which triggers the 
vehicle dynamics controls. The simple integration of the pitch 
rate is : 
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\o) y {T)dr 

o 



which falls to provide an accurate estimation of the vehicle 
pitch attitude signal used in vehicle dynamics controls (for 
example used in roll stability control and hill decent 
control). This simple integration merely leads to accurate 
prediction of the pitch attitude signal if the roll attitude 
signal angle is negligible and the yaw rate is not extremely 
large . 

The yaw attitude signal angle . is obtained from simple 
integration of the yaw rate sensor if the pitch and roll 
attitude signal are negligible with non-extreme pitch rate.. 

[0038] The following is simultaneously true: 

if 0 X ~O and 0 y ~O, or 0 X ~ 0 and co z ~0. That is, either the 

vehicle has small roll and pitch attitude signal angles, or 
the vehicle has a small roll attitude signal angle plus a 
small yaw rate. This contradicts with the purpose of using 
them in rollover and pitch-over detection, since both roll and 
pitch attitude signal angles are large, and vehicles usually 
experience combined roll, pitch and yaw motions. 

[0039] A direct integration for (1) can be formulated to 
include the following: 

0 x (k + 1) = 0 X (k) + {Q) x (k + 1) + [a> y (k + 1) sm(0 x (*)) + co z (k + 1) cos(0 x (*))] tan(0 y '(*)) } AT 

0 y {k + 1) = 0 y (k) + { Q) y (k + 1) cos(^. (k))-G) z (k + l) sin(0 x (k)) }AT 

0 Z (k + 1) = 0 Z (k) + { [o> y (k + 1) sintf, (*)) + Q) z (k + 1) cos(0 x (k))]scc(0 y (k))}AT 

where AT is the sampling time of the controller. This 
integration tends to drift due to sensor error and due to 
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numerical computation error. Periodically, the attitude 

signals are required to be initialized to some reference 
signals, for example: 

• 0AN) = 0 x . REF (N) 

O y (N) = 0 y _ REF (N) 

for N to be chosen as the multiple of the periods or feeding 
the attitude signal error between the generated attitude 
signals and the reference signals: 



0 y W-0 y _ REF (k) 



into a Kalman filter or an extended Kalman filter such that 
generated attitude signals converge to true attitude signals. 
In aerospace industry, such reference signals are usually 
obtained through the signals from a GPS system. 

[0040] In the present invention, reference attitude signals 
are obtained through a road constraint. The road constraint 
considered here is a function of the inference that, on 
average, the vehicle is driven on the road (which could be 3- 
dimensional) , and that the vehicle contacts the road and does 
not have a large take-off velocity. This road constraint, the 
Kinematics Road Constraint (KRC) , does not exclude . the 
potential vehicle take-off velocity due to road unevenness 

(e.g., bumps) causing vehicle heave vibrations. The average 
vehicle heave velocity, however, is around zero; or the low 
frequency portion of the vehicle heave velocity is zero. This 
unique operating condition for automotive vehicles allows the 
preset invention to eliminate the need for external sources 
like GPS to calculate reference attitude signals. 
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[0041] From a dynamics point of view, the road constraint 
balances the vehicle tire forces on the average road surface 
plane, which shall be referred to as the Dynamic Road 
Constraint (DRC) . DRC combined with the aforementioned . KRC 
provide unique operating conditions for automotive vehicles, 
which is a key for us to conduct reference signal computation 
without using additional external sources (in comparison with 
using GPS in an INS/IMU system) . 

[0042] Due to the road constraint, a reference attitude signal 
can be generated as a function of the aforementioned three 
accelerometer outputs and the three angular rate outputs from 
the sensor cluster, the vehicle reference velocity generated 
from the wheel speed signals, the steering angle, together 
with the vehicle dynamics model. Such computations are 
performed in a reference signal generator unit 15, which 
generates the reference signal therefrom. The vehicle 

reference velocities include longitudinal reference velocity, 
lateral reference velocity or a side-slip angle signal J3 
(relative yaw attitude signal) . 

[0043] The reference velocities and reference attitude signal 
angles are denoted as : 



V x-REF 


= vehicle longitudinal reference velocity 


V y-REF 


= vehicle lateral reference velocity 




= vehicle vertical reference velocity 


&X-REF 


= vehicle roll reference attitude 


@y-REF 


= vehicle pitch reference attitude 


0 Z -REF 


= vehicle yaw reference attitude 



where Vkef : > v } -ref » v z -ref characterize the jc, y 9 z -directional 
velocities of center of gravity of the vehicle body in the 
body-fixed x, y, z -axes . 6 * X _ REF ,6 * y _ REF ,6 \_ REF are the so-called Euler 
angles of the vehicle body with respect to a level ground like 
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sea level. ^x-ref^x-ref^ z -ref are also the global reference roll, 
pitch and yaw attitude signals. 

[0044] V *- REF is generated from the wheel speed sensor signals, 
the steering angle, the yaw angular rate and other generated 
variables. Important to note is that the reference velocities 
and reference attitude signals are normally determined . for 
antilock braking systems, traction control systems, yaw 
stability control, and roll stability control . 

[0045] The road constraint assumption implies that: 

V z~REF =0 

around low frequencies. Hence only three reference signals 
v 0 0 

y—REF » x-ref> y-REF neec j to be generated. Therefore, the reference 
signal generator 15 contains a lateral reference velocity 
computation unit ; for , computing reference lateral velocity 

signal V *- REF , a roll attitude signal reference computation unit 

0 

for computing the reference roll attitude signal x-ref f a pitch 
attitude signal reference computation unit for computing the 
reference pitch attitude signal 0 X _ REF . 

[0046] Since the vehicle longitudinal velocity can be obtained 
from the wheel speed sensors, there is no need to calculate a 
reference signal for v x _ REF , i.e., the vehicle speed, generated 
in the ABS system or the traction control system or the yaw 
stability control system are used. For an automotive system, 
the global yaw attitude signal has no impact on vehicle 
motion. Therefore, the yaw attitude signal of the vehicle 
with respect, to the path that the vehicle must follow is used. 
Such relative yaw attitude signal is the side-slip angle 
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signal, which is further related to the lateral velocity 
signal of the vehicle. 



[0047] Therefore, the applicable reference signals in the RSG 
unit 15 are the lateral directional reference velocity v l REF , 

the reference global roll attitude signal 6 X . REF and the 

reference global pitch attitude signal 0 y _ REF , and the relative 

reference yaw attitude signal J3 REF . 

[0048] Reference signals should be obtained from the 
kinematics road constraint. The sensor signals from the three 
directional accelerometers and the three gyros in the IMU 16 
operate as a function of the following kinematics: 

a xs : =v x -O)^v y +a) ys v z -gsin(0 y ) 

^ys=^ y + ^v x -co xs v z ^gsin{0 x )cos{e y ) (3) 

a „ = v z - <o ys v x + <y xv v v + g cos(0 x ) cos(0 y ) 

for the vehicle true directional velocities and true attitude 
signals. For automotive applications, equation (3) can be 
further simplified as the following: 

a y S ~ v, ■+ 0) zs v x - 0) xs v z + g sin(0 A . ) ( 4 ) 

a z>~V z -6>ysV x +(O xs V y + g 

[0049] The KRC constraint implies that v z ~0 and v 2 =0, hence 
mathematically KRC includes the following conditions for the 
involved reference signals, hereinafter referred to as the KRC 
condition: 

&v V y-REF - 8 sin(^,_^ £F ) = ft, - v x 

g $m(0 x _ REF ) + v y _ REF = a ys - (O zs v x ( 5 ) 

^y-REF = a zs '+ &ysV x ~ g 
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[0050] Because the lateral velocity signal already contains 
the gravity portion, the total lateral acceleration projected 
on the road surface will satisfy the following: 

~ a ys cos(0 x : relative ) - g s'm(0 x _ relative ) 

and the yaw rate signal around the axis perpendicular to the 
average road surface will satisfy: 

^z-road = ^ ^(^y-relarive ) + & ys sin (^ K-relanv? ) COS (^wW*m* ) + <°zs x-relative ) y- relative ) 

(7) 

[0051] Along the average road surface, the wheel contacting 
road implies that all the forces must be balanced at the 
contact patches. Therefore, 

„ l jKrori ~ M z + K Ma y -roa d 
F f=- 



t f cos( 5) 

' ' (8) 



where F f and F r are the lateral forces applied to the front 

axle and rear axle through tires respectively; M z is the 
yawing moment due to yaw stability control, which can be 
estimated as a function of the desired yaw stability command 
and the estimated road surface fi ; I z is the yaw momentum of 
inertia of the vehicle; M is the vehicle total mass; . ^ is 
the distance from the vehicle center of gravity to the front 
axle; t r is the distance from the vehicle center of gravity 

to the rear axle; 8 is the steering angle at the front wheels. 
On the other hand, if the vehicle tires are contacting the 
road surface, the following is true: 
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Leo 

f w z~road 



v.. 



(9) 



[0052] Therefore, equation (9) is the DRC condition. 

[0053] As a function of the KRC condition shown in (5), the 
reference signals can be generated as in the following: 



V y-REF 



0 x -ref = sin" 



Oy-REF = Sin " 



Pref = tan" 



_a z +Q} ys v x -g 



s J 

- a *,-Vx-°> a V y-REF 
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y—REF 



(10) 



[0054] As a function of the DRC condition shown in (9), the 
reference signals can be obtained as in the following: 



R Jr^-roa d ~ l z^z-roaJ + M z + t f Md y _ roQd 

Href ~ "•" ^ „ 

v, t r C r 

Vv-ref =v x tari(p REF ) 



(11) 



[0055] Important to note is that the computation for reference 
lateral velocity signal is singular around a) xs =0. In order to 
eliminate such singularity, several remedy will be provided. 
The first remedy is due to the limit theorem, which says the 
following is true for continuous functions: 



d +ti) v +Q) v 

Km v v ref = Hm ; ys x ys 



a>„^>0 



(12) 
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[0056] Therefore, the following logic for reference lateral 
velocity signal computation is generated: 



if\coJ> £i 

_ a z +a> ys v x -g 

CO 

w xs 

elseif | co xs \>E X &\ Q) xs \> £ 2 

d +0) v + 0) v 

z ys x w ys x 

y—REF ~ ; : 

CO 

else 



(13) 



;■ v y _ REF =0 

where e x and e 2 are two thresholds which are determined as a 
function of vehicle testing. In other words, when the vehicle 
has significant roll rate or roll rate velocity equation (10) 
can be used. Hence equations (10) and; (13) are likely to 
cover a small window for reference lateral velocity. For 
cases where vehicle does not have significant roll motion, 
other' methods may be required. 

[0057] Considering that the reference signals in equation (11) 
obtained from DRC condition can be also used to remedy the 
singular point for equations (10), (13) is further expanded, 
as in the following to include small roll motion cases, 

for a given X< \ : 
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if\coJ>e i 

_ a z + G) YS v x -g 
Vy - REF ~ CO 

*"xs 

elseif\(O xs \<e i &\d) xs \>e 2 

+ <o u cos{e x _ relative )cos{e y _ rela , ive ) 

Pref ~ v ~ tC 

V«f = Av, tanC/^ ) + (1 - A) 8 V- >— 

else 

"y-roaJ = a ,, ZO*{9 x ^ ebulve ) ~ g x - relative) 

<»z-road=-<0xsS™&y-reU,rt V e) + &y S Si^ 

+ a> a cos(O x _ nlalive )cos{O y _ relalive ) 

V / C 

[0058] The reference signals generated from the reference 
signal generator 15 are generally accurate at low frequencies 
because the low frequency portion of the heave velocity of a 
vehicle body is almost zero. Hence the lower-pass filtered 

Vy-REF^x-REF^y-REF matches the low frequency portion of the actual 
vehicle states of lateral velocity signal v y , roll attitude 
signal 0 X and pitch attitude signal 0 y . That is: 



LPF x [v y _ REF ] = LPF\v y } 
LPF 2 [0 x _ REF ] = LPF 2 [0 x ] 
LPF 3 [0 y _ REF ] = LPF 3 [0 y ] 
LPF 4 [/3 REF ] = LPF 4 [J3] 



(15) 



The low-pass-filters LPF lJ LPF 2 ,LPF 3 ,LPF 4 have various cut-off 
frequencies Q) c] ,co c2 ,a) c3 ,co c4 which are optimized and tuned as a 
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function of the real data. Hence the above conditions will be 
used in Global Attitude signal Determination (GAD) Unit and 
Directional Velocity Determination (DVD) Unit of the ISS to 
calibrate and correct the actual computations for the true 
lateral velocity signal v v , the roll . attitude signal 0 X and the 

pitch attitude signal 0 y and the side-slip angle signal 
(relative yaw attitude signal) p . 

[0059] In order to solve the nonlinear differential equations 

in real-time for the attitude signal angles 0 r and 0 V , the 

y 

simple numerical integration, as shown above, is generally not 
applicable because the sensor errors and numerical errors both 
tend to cause integration drift off, i.e., the integration 
errors increase over time. Therefore, the reference signals 
from the reference signal generator (RSG) are used. Important 
to note is that only the low frequency portion of the 
reference signals y y - REF ,0 x _ REF9 0 y „ REF are close to the true vehicle 
variables . 

[0060] In order to reduce or eliminate pure-integration- 
induced drift, filters or anti-integration-drift filters (AID) 
are used for solving the nonlinear differential equations 
shown above. Such filters can be expressed as in the 
following for 2 nd order case: 

t r-~h- 4i(i-z~ 2 ) 
l-c n z +c i2 z 

where i = 1,2,3 , d n ,c n ,c i2 are the filter coefficients. 

[0061] 0 X is the generated vehicle attitude signal for roll 

attitude signal angle, 0 y for pitch attitude signal angle, 
therefore the total roll and pitch velocities using the past 



21 



estimated value of the vehicle attitude signals can be 
computed as in the following: 



+ = ^x(* + l) + [o^(* + l)sm(^ 

e^(*+i) = <y^ 

Then the digital implementation of the filter can be expressed 
as the following for roll attitude signal: 

3M*(* + 1) = *12^ 

0x-dyn(°) = 0 xO (16) 

and for pitch attitude signal: 

0y- dyn (O) = 0 yO - (17) 

[0062] The previous two equations (16), (17) perform 
integrations but remove the potentially correct low frequency 
portion. Therefore, the useful low frequency portion should 
be recovered. Such recovery is possible due to the road 
constraint assumption, as was previously mentioned. If the 
lbw-pass-f ilters are chosen as the following for / = 1,2,3-; 

'LPF f (z^) = gfl+g " z " l " g ° z ] 2 
\-c n z +c i2 z 

where the filter coefficients satisfying the following 
constraints: 

e n =e i2 +e i3 
2e g2 =l-c n +c g2 

Then the low frequency portion of the reference variables . are 
generated from the following digital schemes: 
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0 x -i Pf (* + D = cj x „ lpf (k) - c 22 ^.. //7/ (k - 1) + (/: + 1) + e 22 0 A .^ £F (*) -e 23 0 x _ REF (k - 1) 

for low frequency roll attitude signal: 

^ (* + 1) = cJ y _ lRf (k) - cj y _ lpf (k - 1) + e n 6 y _ REF {k + 1) + e 23 0,_* EF (*) - e^ REF {k - 1) 

0y-lpf(O) = 0y-REFO 

[0063] Therefore the roll and pitch attitude signal can be 
determined as in the following: 

[0064] The above computations are performed at the attitude 
signal determination unit or global attitude signal unit 76, 
which generates the global attitude signal therefrom. 

[0065] Determining vehicle, lateral velocity signal can be 
conducted as a function of reference lateral velocity signal 

V y-REF ' the lateral acceleration, the yaw rate, the steering 
angle, the past value of the generated roll and pitch attitude 
signals. The similar two-filter structure used previously 
herein is also required. This is performed at the directional 
unit or the directional velocity unit 78, which generates the 
directional velocity signal therefrom. 

[0066] The relative attitude signals of the vehicle with 
respect to the average road surface can be: 

e y-relative( k + X ) 

where 



= e n 9 



*A-«h*.(*) + «J®.(* ■+ 1) + ©.(*)] 

= /oire^eW + + 1) + ©,<*)]' 
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©,<*) 

9 y (k) 



= —auj x (h) 4- ba y (k) 
= gv y (k) - ha x (k) 



These computations are also performed in the attitude signal 
unit 74, which generates a relative attitude signal therefrom.: 

[0067] Since one of the angular rates can be estimated from 
the rest of the sensor signals in the sensor cluster 16, the 
generated variables, and the reference variables; the sensor 
plausibility can be checked within the controller. For 
example the pitch rate sensor can be estimated as: 

uj y = 0 y sec(0 x ) + lj z tan(&J 

Therefore by comparing the pitch rate sensor output with the 
above estimated pitch rate, pitch rate sensor plausibility can 
be conducted. The plausibility for roll rate sensor and yaw 
rate sensor can be similarly performed. Those are generated 
within the sensor; check unit or sensor plausibility unit 80, 
which generates a sensor plausibility signal therefrom. 

[0068] Because of the relationships between the sensor 
signals, the sensor mounting errors can also be corrected 
within the controller 12. For example, the pitch misalignment 
of the sensor cluster can be calculated as in the following 



A0 y = sin 



-i 



-sin 



y J 



where 



K = a xs + a> u v y + S sin(0 yS// ) 
A, =a^- (o xs v y + g cos(0 yS/l ) 
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and v A . and v y is the vehicle longitudinal and lateral 
velocities calculated on the road frame. For example, v x can 
be calculated based solely on the wheel speed signals, v v can 

be calculated based on a linear bicycle model of the vehicle. 
In this case, the above computation will be conducted 
conditionally: for example, the vehicle is driven straight 
with deceleration or acceleration. 

Similar misalignment or mounting errors of the other sensors 
are also performed. The sensor information is then used to 
conduct real-time calibration for sensor signals. For 
example, the rolling radius calibration for wheel speed 
sensors can be performed as a function of the available sensor 
signals and the generated signals. Those computations are 
conducted at the sensor compensation unit or sensor signal 
unit 84, which generates a sensor compensation signal 
therefrom. 

[0069] The sensors also provide information for estimating and. 
predicting the road profile, the road surface and the road 
curvatures. Such computations are conducted in the road 
profile unit 72, which generates a road profile, signal 
including but not limited to surface friction level, surface 
unevenness (roughness) , road inclination and bank angle, 
therefrom. 

[0070] The abnormal conditions of the vehicle are also 
detected and monitored in the system. These abnormal 

conditions include tire under-inf lation, tire imbalance, tire 
wear, tire misalignment, actuator failure, wheel lifting, etc. 
Such functions are performed in. an abnormal state unit or 
abnormal state monitoring unit 82, which generates the 
abnormal state signal as a function thereof. 
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[0071] The forces and torques applied to the wheels play 
important roles in many vehicle control functions. The system 
10 also conducts estimation of and prediction of those 
loadings in an estimation unit or force and torque unit or . 
force and torque estimation unit 86 (FATE), which generates 
the force and torque signal as a function thereof . 

[0072] The reference attitude signal, generated as a function 
of all the sensor signals and the road constraint assumption, 
is used to correct the attitude signal computation errors. 

[0073] In addition to the sensor cluster 16, the system 10 
also includes wheel speed sensors 24, a wheel steering angle 
sensor 26, suspension height sensors, and any actuator 
specific sensors 32 e.g., the brake pressure sensors and all 
the other sensors, which are used for subsystem controls. 
Hence the system 10 generates the vehicle operation states, 
such as: vehicle attitude signals with respect to the average 
road surface, vehicle directional velocity, road profile and 
surface conditions, traction forces, and tire forces. 

[0074] Another aspect of the system 10 is the ability to 
conduct sensor plausibility checks, sensor error compensation, 
and abnormal vehicle state monitoring and detection because 
all the sensor signals are available to the system 10. Many 
of the sensor signals have cross influences over other sensor 
signals, and there are interconnecting relationship among all 
the sensor signals. 

[0075] Referring to Figure 3, the dynamic system controller 33 
receives the reference lateral velocity signal and generates a 
dynamic control signal in response as a function thereof. The 
dynamic system controller may include a yaw stability 
controller 40, a roll stability controller 42, an ABS 
controller 44, or a TCS controller 46, or any combination 
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thereof either separate or together in a single dynamic system 
unit. 

[0076] The braking system controller 34 or safety device 
controller/vehicle safety system receives the dynamic control 
signal and generates a braking signal in response thereto. 
The braking system controller 34 includes control function 
priority/arbitration/integration logic 35 and brake 
communicating and brake command controllers 37. 

[0077] The braking, system controller 34 receives at least one 
of a plurality of signals including: the road profile signal, 
the vehicle attitude signal, the global position signal, the 
vehicle direction signal, the sensor plausibility signal, the 
abnormal state signal, the mounting sensor error correction 
signal, and the force and torque signal. In one embodiment of 
the present invention, the braking system controller 34 checks 
the reference lateral velocity signal with the at least one of 
the plurality of signals. In alternate embodiments, the 
braking system controller 34 predicts future vehicle states 
from at least one of the aforementioned signals and activates 
safety devices in response thereto. 

[0078] The various alternate known actuators 36 include active' 
steering systems, active braking systems, active transmission 
systems, drive- train controls, power-train controls, throttle 
controls, controllable suspensions, controllable anti-roll- 
bar, etc. The actuators 3 6 are activated in response to ' the 
signals generated from the integrated system controller 12. 

[0079] Referring to Figure 4, a logic flow diagram 100 of a 
method for controlling a vehicle dynamic system, in accordance 
with another embodiment of the present invention, is 
illustrated. Logic starts in operation block 102, where the 
vehicle 14 experiences an RSC event. The sensors within the 
sensor cluster 16 respond to RSC event data by generating 
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sensor signals, as was previously discusised. In. operation 
block 104, the sensor cluster signals and various . other 
vehicle sensor signals are received in the integrated system 
controller 12 . 

[0080] In operation block 106, the integrated system 
controller 12 estimates, current vehicle states and reference 
velocities and predicts future vehicle states in response to 
the RSC generated sensor signals. 

[0081] In operation block 108, a dynamic system controller 33 
receives the integrated system controller signals and 
generates therefrom stability control signals. 

[0082] In operation block 110, the braking controller 34 
receives the dynamic system controller signals and generates 
therefrom braking signals. In response thereto, in operation 
block 112, vehicle actuators 36 and vehicle systems are 
activated to respond to or compensate for the RSC event. In 
operation block 114, the vehicle actuators 3 6 and systems 
compensate for the RSC event and attempt to stabilize the 
vehicle 14 . 

[0083] In operation, a method for controlling a safety device 
for a vehicle includes generating a reference lateral velocity 
signal as a function of a kinematics road constraint 
condition, a dynamic road constraint condition, and 
singularity removal logic; eliminating a singular point in a 
computation of the reference lateral velocity signal; 
generating a lateral velocity signal, a roll attitude signal, 
a pitch attitude signal, and a side slip angle signal as a 
function of a reference computational method including the 
kinematics road constraint; generating a lateral velocity 
signal and a reference side slip angle signal from the dynamic 
road constraint condition as functions of the kinematics road 
constraint; generating a dynamic control signal in response to 
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the reference lateral velocity signal; and receiving the 
dynamic control signal and further generating a vehicle safety 
device activation signal in response thereto. 

[0084] The method also includes generating an attitude signal 
reference computation, generating a road profile signal, 
generating, a vehicle attitude signal, generating a global 
position signal, generating a vehicle direction signal, 
generating a sensor plausibility signal, generating an 
abnormal state signal including information regarding abnormal 
vehicle conditions, generating a mounting sensor error 
correction signal, generating a force and torque signal in 
response to forces and torques applied to the vehicle, 
generating a body fixed frame to roll frame signal, generating 
a normal load signal, generating a vehicle parameter signal, 
and generating the safety device control signal in response to 
a combination of the attitude signal reference computation, 
the road profile signal, the vehicle attitude signal, the 
global position signal, the vehicle direction signal, the 
sensor plausibility signal, the abnormal state signal the 
mounting sensor error correction signal, and the force and 
torque signal. 

[0085] While particular embodiments of the invention have been 
shown and described, numerous variations and alternate 
embodiments will occur to those skilled in the art. 
Accordingly, it is intended that the invention be limited only 
in terms of the appended claims. 
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